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Prufungsantrag gem. § 44 PatG ist gestellt 

@ Verfahren und Vorrichtung zur Regelung der Vorhalteposition eines Manipulators eines Handhabungsgerats 

@ Die Erfindung betrlfft ein Verfahren zur Regelung der 
Vorhalteposition eines in mehreren Freiheitsgraden be- 
wegbaren Manipulators (2) eines Handhabungsgerats (1) 
relativ zu einenn Objekt (3) entlang einer Verfahrbahn. Urn 
eine schnellere Regelung der Vorhalteposition zu ermog- 
lichen, wird vorgeschlagen, dass mehrere Punkte zumin- 
dest eines Teils der Ist- Verfahrbahn gespeichert sind und 
fur eine vorausschauende Regelung der Vorhatteposltlon 
des Manipulators (2) entlang dieses Teils der Verfahrbahn 
herangezogen werden. 
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Beschrcibung 

Die vorliegende Erfindung betrifft ein Verfahren und eine 
Vorrichtung zur Regelung der Vorhalleposition eines in 
mchrcren Freihciisgraden bcwcgbarcn Manipulators eines 5 
Handhabungsgenils relaliv zu einein Objekl enllang einer 
Verfahrbahn. Die Erfindung betrifft auBerdem ein Handha- 
bungsgerat mit einem in mehreren FreiheiLsgraden beweg- 
barcn Manipulator, dessen Vorhalteposition relaliv zu einem 
Objekt regelbar ist. lO 

Das Handhabungsgerat ist bspw. als ein mehrgelenkiger 
Industrie-Roboter ausgebildei. Derartige Tndustrie-Roboler 
wcrdcn insbcsondcrc in der Automobilindustrie in der Fcni- 
gung und der Qualitatssicherung eingeselzt. Fur die unler- 
schiedlichen Einsatzmoglichkeiten eines Industrie-Roboters ts 
kann der Manipulator beliebig ausgebildet sein. 

Der Manipulator ist bspw. als ein Werkzeug, insbesondere 
als ein SchweiBgeniL, als ein Gerat zum Auflragen von 
Klebstoff, von Farbe oder von anderen Beschichtungen auf 
eine Oberflache» als ein Bearbeitungsgerat o. a. ausgebildet. 20 
Zum Ergreifen eines oder mehrerer Objekie kann der Mani- 
pulator als ein Greifer, ein Saugnapf o. a. ausgebildei sein. 
SchlieBlich ist es denkbar, dass der Manipulator als ein 
Messkopf z. B. zum Messen des Oberflachenverlaufs eines 
Objekts, einer Spallbreite, eines Spaltversalzes, einer 25 
Schichtdicke o. a. ausgebildet ist. 

Damit der Manipulator die ihm zugedachte Aufgabe er- 
fiillen kann, muss er in eine definierte Vorhalteposition rela- 
liv zu einem Objekt gebrachl werden. Unier dem BegrifT 
Vorhalteposition wird gemaB dem vcrliegenden Patent so- 30 
wohl die Positionierung als auch die Ausrichtung des Mani- 
pulators rclativ zu dem Objekt vcrstanden, 

Aus dem Stand der Technik sind Handhabungsgerate be- 
kannt, die eine interne Steuerungseinrichtung aufweisen. 
Auf der Steuerungseinrichtung isl ein Steuerungsprogramm 35 
lauffahig, durch das der Manipulator entlang einer program- 
mierten Verfahrbahn in die Vorhalteposition bewegt werden 
kann. Wenn das Objekt stets an derselben Position angeord- 
net ist, reicht eine solche Steuerung der Verfahrbahn bis zur 
Vorhalteposition vollkommen aus. Falls die Position des 40 
Objekts jedoch gewissen Schwankungen unterworfen ist, 
was der Regelfall ist, kann durch eine Steuerung alleine 
nicht mehr sichergestellt werden, dass eine bestimmle Vor- 
halteposition des Manipulators relaliv zu dem Objekt stets 
mit der erforderlichen Cjenauigkeit eingenommen wird. 4.s 
Schwankungen der Position des Objekts konnen vielerlei 
Ursachcn habcn. 

Um sicherzuslellcn, dass die Vorhalteposition des Mani- 
pulators relaliv zu dem Objekl auch bei Schwankungen der 
Position des Objekts stets mit der geforderten Genauigkeil 50 
eingenommen wird, isl cs aus dem Stand der Technik eben- 
falls bekannt, die Vorhalleposition des Manipulators relaliv 
zu dem Objekt zu regeln. Aus dem Stand der Tbchnik sind 
unterschiedliche Verfahren zur Regelung der Vorhaltepos- 
ition des Manipulators bekannt, Diese bekannten Verfahren 55 
zur Regelung der Vorhalleposition sind jedoch sehr kompli- 
ziert und langsam. 

Im Rahmen der Regelung der Vorhalteposition des Mani- 
pulators relaliv zu einem Objekt wird die Ist- Vorhaltepos- 
ition des Manipulators zunachst miltels Sensoren erfassi und 60 
dann auf eine Soil- Vorhalteposition geregelt. Die Sensoren 
sind bspw. als optische oder als laktile Sensoren ausgebildet. 

Insbesondere sind sie als Laser-Sensoren zum Messen 
von Abstanden, als Kraft/Momenten-Sensoren zum Messen 
von KrSflen bzw. Momenten oder als Beriihrungssensoren 65 
zur Deteklion einer Beriihrung mil dem Objekt ausgebildet. 

Die Sensoren sind in einem bcstimmtcn Bezug (Position 
und Ausrichtung) zu dem Manipulator angeordnet. Vor der 
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Regelung der Vorhalteposition mUssen die Sensoren in ci- 
nen konkreien Bezug zu dem Manipulator und zu dem Ob- 
jekt gebrachl werden (Einrichten) und die Parameter der Re- 
gelung an den konkreien Bezug angepasst werden (Kalibrie- 
ren), Der Bezug der Sensoren zu dem Manipulator kann sich 
aufgrund von Temperalurschwankungen, mechanischen 
Einwirkungen auf die Sensoren oder den Manipulator, o. a. 
verSndem, wodurch ein emeutes Kalibrieren unci u, U. sogar 
eine cmeules Einrichten der Vorrichtung zur Durchfuhrung 
der Regelung notwendig wird. Wahrend des Einrichtens und 
Kalibrierens slehl die Vorrichtung nichi fiir eine Regelung 
zur VerfQgung, die Regelung der Vorhalteposition muss un- 
lerbrochcn werden. 

Samtliche bekannten Verfahren zur Regelung der Vorhall- 
eposition des Manipulators haben auBerdem den Nachteil, 
dass die Verfahrgeschwindigkeit des Manipulators relaliv 
klein ist, da die Regelung in Unkenntnis der bevorslehen- 
den, zu regelnden Verfahrbahn des Manipulators erfolgl. 
Deshalb muss die Verfahrgeschwindigkeit so klein gewahlt 
werden, dass auch im Hxtremfall einer Verfahrrichtungsum- 
kehr eine rasche und genau Positionierung des Manipulators 
sichergestellt werden kann. Bei einer zu hohen Verfahrge- 
schwindigkeit wurde der Manipulator bei stark gekriimmten 
Verfahrbahnen oder einer Verfahrrichtungsumkehr aufgrund 
der MassenU-agheit liber die geregelte Verfahrbahn hinaus- 
schieBen und somit die geregelte Verfahrbahn verlassen. 

Es ist deshalb eine Aufgabe der vorliegenden Erfindung, 
ein Verfahren der eingangs genannien Art dahingehend aus- 
zugeslalten und weilerzubilden, dass eine mdglichsl 
schnelle Regelung der VDrhalieposition erreicht und dass 
insbesondere h5here Verfahrgeschwindigkeiten des Mani- 
pulators auf der Verfahrbahn realisiert werden kbnnen, ohne 
dass es zu einem Verlust an Regelungsgenauigkeil kommt. 

Zur Losung dieser Aufgabe schlagl die Erfindung ausge- 
hend von dem Verfahren der eingangs genannten Art vor, 
dass mehrcre Punkte zumindcst eines Teils der Ist- Verfahr- 
bahn gespeichert sind und fiir eine vorausschauende Rege- 
lung der Vorhalteposition des Manipulators enllang dieses 
Teils der Verfahrbahn herangezogen werden. 

ErfindungsgemaB ist erkannl worden, dass die Regelung 
der Vorhalteposition durch eine vorausschauende Regelung 
auf einfache Weise entscheidend beschleunigl werden kann. 
Wahrend der vorausschauenden Regelung der Vorhaltepos- 
ition wird der bevorstehende Verlauf der Verfahrbahn be- 
rOcksichtigl, Wenn der bevorstehende Verlauf der Verfahr- 
bahn es zulassi, bspw. bei einer geraden oder einer nur ge- 
ringfiigig gekriimmten Verfahrbahn, kann die Verfahrge- 
schwindigkeit des Manipulators hoch gewahlt werden. Da- 
durch kann die Regelung der Vorhalteposition entlang einer 
Verfahrbahn entscheidend beschleunigl werden. Bei zuneh- 
mender Krummung der bevorslehcndcn Verfahrbahn muss 
die Verfahrgeschwindigkeit zunehmend reduziert werden. 
Durch die Wahl einer geringen Verfahrgeschwindigkeit bei 
slarken Kriimmungen der bevorstehenden Verfahrbahn kann 
zudem die Genauigkeil der Regelung der Vorhalteposition 
des Manipulators entlang der Verfahrbahn entscheidend er- 
hohl werden. Bei dem erfindungsgemafien Verfahren kann 
die Verfahrgeschwindigkeit somit dem Verlauf der bevorste- 
henden Verfahrbahn individuell angepasst werden. 

Die Punkte der Ist- Verfahrbahn konnen auf unterschiedli- 
che Weise, z. B. empirisch, simulauv oder durch Berech- 
nung, besdmml werden. Bei der empirischen Bestimmung 
der Punkte der 1st- Verfahrbahn konnen die einzehien Punkte 
entweder mit dem Manipulator des Handhabungsgerats ma- 
nuell oder von einer ersten Steuereinrichtung gesteuen an- 
gefahren werden. Bei der simulativen Bestimmung der 
Punkte wird zunachst ein Modell des Handhabungsgerats 
und des Objekts, vorzugsweise auf einem Computer, er- 
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stcUi. Anhand dieses Modells wird dann durch Simulation 
der Verfahrbahn die Isl-Verfahrbahn besUmml. Bei der ma- 
ihemadschen Berechnung der Punkte der 1st- Verfahrbahn 
wird zunSchst ein mathematisches Modell des Handha- 
bungsgerats und des Objckls crsicUl, und die Punkte werden 5 
dann durch Ldsen mathematischer Gleichungen berechnel, 

GemaB einer vorteilhaften Weiterbildung der vorliegen- 
den Erfindung wird voi]geschlagen, dass die Isi- Verfahrbahn 
des Manipulators vor der Rcgelung der Vorhalteposition ab- 
gefahien wird und dabei die Punkte zumindesl eines Teils 10 
der 1st- Verfahrbahn aufgenommen und abgespeichert wer- 
den. Die 1st- Verfahrbahn muss nicht mil besonders hohen 
Anforderungcn an die Gcnauigkeit abgcfahrcn wcrdcn, da 
die Verfahrbahn iin Rahmen der nachfolgenden Regelung 
der Verfahrbahn des Manipulators korrigiert werden kann. is 
Die abgefahrene 1st- Verfahrbahn stellt lediglich eine Ab- 
schatzung des Verlaufs der Soil- Verfahrbahn dar und muss 
so genau sein, dass sie fiir eine vorausschauende Regelung 
der Vorhalteposition des Manipulators entlang der Verfahr- 
bahn herangezogen werden kann. 20 

Die Isl- Verfahrbahn wird vorleilhafterweise von dem Ma- 
nipulator vor der Regelung der Vorhalteposition von einer 
internen Steuerungseinrichtung des HandhabungsgeraLs ge- 
sleuert abgefahren. Auf der internen Steuerungseinrichtung 
lauft ein Steuerungsprogramm ab, in dem die einzelnen 25 
Punkte der Isi- Verfahrbahn progranuniert sind. Das Steue- 
rungsprogramm steuert das Handhabungsgerai derart an, 
dass der Manipulator wShrend des Ablaufs des Steuerungs- 
programnis die 1st- Verfahrbahn abfahrt. Dabei werden die 
Punkte zumindest eines Teils der 1st- Verfahrbahn aufge- 30 
nommen und abgespeichert. AuBer den in dem Steuerungs- 
programm programmicrten Punktcn dor 1st- Verfahrbahn 
konnen noch zusatzliche Punkte der 1st- Verfahrbahn aufge- 
nommen und gespeichert werden. 

Die Punkte zumindest eines Teils der 1st- Verfahrbahn 35 
werden vorzugsweisc von einer cxlcrnen Regelungseinrich- 
tung aufgenommen und abgespeichert. Auf der extemen Re- 
gelungseinrichtung lauft ein Regelungsprogramm ab, das 
die Vorhalteposition des Manipulators auf der Verfahrbahn 
rcgclt. Die extcrne Rcgclungseinrichtung ist bspw. als ein 40 
Personal Computer (PC) oder als ein Indusuie-PC ausgebil- 
det. Das Regelungsprogramm kann in einer Standard-Pro- 
granuniersprache programmiert und ohne groBen Aufwand 
umprogrammicrt wcrdcn. In cincm bcstimmten Modus (Re- 
cord-Mode) vor der Regelung der Vorhalteposition kann das 45 
Regelungsprogramm auch die Punkte der von dem Manipu- 
lator abgefahrcncn Isl- Verfahrbahn aufnchmcn und abspei- 
chcm. Die gcspcichcrtcn Punkte werden dann in eincm an- 
deren Modus (Operation-Mode) fiir die vorausschauende 
Regelung der Vorhalteposition herangezogen. 50 

GemaB einer andercn vorteilhaften Weiterbildung der 
vorliegenden Erfindung wird vorgeschlagen, dass die ex- 
teme Regelungseinrichtung von der internen Steuerungsein- 
richtung aufgerufen wird. Das Steuerungsprogramm der in- 
ternen Steuerungseinrichtung ist ublicherweise in einer pro- 55 
prietaren, nur auf der Steuerungseinrichtung eines bestimm- 
len Handhabungsgeniis lauffahigen Programmierungsspra- 
che programmiert. Es ware nur mil einem groBen Aufwand 
moglich, das gesamte Regelungsprogramm in das Steue- 
rungsprogramm zu integrieren. Deshalb sind in dem Steue- 60 
rungsprogramm besiimmie Programmierbefehle (Aufrufbe- 
fehle, Ruckholbefehle) vorgesehen, um das Regelungspro- 
gramm der extemen Regelungseinrichtung von dem Steue- 
rungsprogramm aus aufzurufen. Das EinfUgen dieser Pro- 
grammierbefehle in das Steuerungsprogramm isl mil einem 6S 
geringen Aufwand moglich. Je nach dem in welchem Mo- 
dus die Regelung betricbcn wird, werden durch cincn Auf- 
ruf des Regelungsprogramms der Regelungseinrichtung die 
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Punkte der Ist- Verfahrbahn aufgenommen und gespeichert 
(Record-Mode) oder die Vorhalteposition vorausschauend 
geregelt (Operadon-Mode). 

In einer anderen vorteilhaften Weiterbildung der Erfin- 
dung wird vorgeschlagen, dass vor der Regelung der Vor- 
halteposidon die Soil- Vorhalteposition des Manipulators an- 
gefahren wird, wahrend einer VerSnderung der Soil- Vorhalt- 
eposition um jeweils einen Freiheitsgrad Messdaten, durch 
die die Varhalleposition des Manipulators charaktcrisiert ist, 
aufgenommen und gespeichert werden und die Regelung 
der Vorhalteposition in Abhangigkeit von den Messdaten 
durchgefuhrt wird. Zwischen den aufgenommenen Messda- 
ten und der Position des Manipulators bestchl ein Zusam- 
menhang. Somit sind in den aufgenommenen Messdaten In- 
formationen Uber die Position des Manipulators enihalten. 

Die Soil- Vorhalteposition wird in einem weiteren Modus 
(Parameter- Mode) vor der Regelung der Vorhalteposition 
angefahren. Zum Anfahren der Soil- Vorhalteposition im Pa- 
rameter-Mode werden die im Record-Mode gespeichenen 
Punkte der Ist-Verfahrbahn herangez^ogen. Sobald die Soll- 
Vorhalleposition erreichl isl, beginnt eine IVainingsphase, in 
der fiir die spatere, im Rahmen des Operation-Mode durch- 
gefuhrte Regelung der Vorhalteposition benodgte Informa- 
donen ermittelt werden. 

Wahrend der Trainingsphase wird der Manipulator um 
die Soli- Vorhalteposition um jeweils einen Freiheitsgrad in 
unierschiedliche Vorhaltepositionen relaiiv zu dem Objekt 
bewegt. Der Manipulator wird um jeden Freiheitsgrad in 
Vorhaltepositionen bewegt, die vorzugsweise zu beiden Sei- 
ten der Soll-Vorhalteposition liegen. Die Vorhaltepositionen 
des Manipulators werden durch Sensoren ermittelt, die vor- 
zugsweise an dem Manipulator befestigt sind. Die Sensoren 
liefem Messdaten anhand derer eine Vorhalteposition des 
Manipulators charaktcrisiert isl. Die Messdaten sind bspw. 
die Abstande von den Sensoren zu dem Objekt, Krafte oder 
Momentc, die von dem Objekt auf die Sensoren einwirken. 
Die Messdaten konnen auch Bildmessdaten sein. Bildmess- 
daten werden durch Vermessen von Bildem gewonnen, die 
von einer CCD-Kamera o. a. aufgenommen wurden. Im 
Rahmen der Trainingsphase werden die Messdaten fiir jeden 
der Freiheitsgrade fiir jede der Vorhalteposidonen aufge- 
nonunen. Es ist denkbar, dass die gespeicherten Messdaten 
fur die Regelung der Vorhalteposiuon weiterverarbeitet wer- 
den. Dann ist die Trainingsphase fur dicsc Soil- Vorhaltepos- 
ition abgeschlossen. Der Manipulator kann eine weilere 
Soll-Vorhalteposition anfahren und fur diese Soll-Vorhalt- 
eposition cine wcitcrc Trainingsphase durchlaufen, bis allc 
Soil- Vorhalteposidonen angefahren worden sind. Dann ist 
der Parameter- Mode abgeschlossen. Die spatere, im Rah- 
men des Operauon-Mode durchgefiihrte Regelung der Vor- 
halteposidon wird in Abhangigkeit von den gespeicherten 
Messdaten durchgefuhrt. 

Bei dem erfindungsgemafien Verfahren ersetzt die Trai- 
ningsphase das bei herkommlichen, aus dem Stand der 
Technik bekannten Verfahren zum Regeln der Vorhaltepos- 
ition des Manipulators eines Handhabungsgerals notwen- 
dige Einrichlen (Posiuonierung der Sensoren reladv zu dem 
Objekt) und Kalibrieren (Einstellen der Parameter der Rege- 
lung). 

Auch bei diesem Verfahren, bei dem vor der Regelung der 
Vsrhalieposinon eine Trainingsphase durchlaufen wird, 
werden mehrere Punkte zumindest eines Tfeils der Ist-Ver- 
fahrbahn gespeichert und fUr eine vorausschauende Rege- 
lung der Vorhalteposidon des Manipulators entlang dieses 
Ttils der Verfahrbahn herangezogen. Das Durchlaufen einer 
Trainingsphase vor der Regelung der Vorhalteposidon hat 
die angcgcbenen Vortcilc aber auch ohne diese Mcrkmalc 
des Kennzeichens des Paten tanspruchs 1. Der Schutz des 
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Patents soli sich dcshalb auch auf ein Vcrfahrcn dcr zuletzt 
genannlen Art beziehen, bei dein die im Kennzeichen des 
Patenianspnjchs 1 genannten Merkmale fehlen. 

GemaB einer bevorzugten Ausfuhrungsform der vorlie- 
gcndcn Erfindung wird voigcschlagcn, dass vor der Regc- 
lung der Vorhalieposilion 

- die Sol I- Vorhalieposilion angefahren wird, 

- ein SoU-Mcssvcl£tor mil den Mcssdatcn aufgcnom- 
inen wird, 

- ftlr jeden Freiheilsgrad der Manipulator des Handha- 
bungsgerSts aus der Soll-Vorhalteposition heraus in 
mchrcrc Vorhalteposilioncn bcwcgt und in jedcr Vor- 
halieposilion ein Messveklor aufgenommen wird, 

- fur jeden Freiheilsgrad fOr dieselben Messdalen der 
Messvektoren der Betrag des Gradienlen ermittelt und 
in einer Gradientenmalrix gespeichert wird, und im 
Rahmen der Regelung der Vorhalieposilion 

- ein Korreklurvektor aus der Multiplikation des 
Kehrwerts der Gradientenmalrix mil der Differenz des 
Soll-Messveklors und eines Isl-Messvektors in der Isl- 
Vorhalteposilion des Manipulators oder anhand eines 
anderen geeigneten Verfahrens ermittelt wird und 

- die Vorhalieposilion in Abhangigkeit von dem Kor- 
reklurvektor geregell wird. 

GemaB dieser bevorzugten Ausfuhrungsform werden in 
der Trainingsphase im Parameter-Mode die fur die Soil- Vor- 
halieposilion aufgenommenen Messdalen in einem Soll- 
Messvektor und die Messdalen, die fUr im Rahmen der TVai- 
ningsphase angefahrene Vorhallepositionen aufgenommen 
wurdcn, in Messvektoren gespeichert. Fiir jeden Freiheils- 
grad, um den der Manipulator bewegbar ist, werden also von 
der Soli- Vorhalieposilion aus mehrere Vorhallepositionen in 
jede Richtung angefahren und in jeder Vorhalieposilion ein 
Messveklor aufgenommen. Die Dimension dcr Messvekto- 
ren entspricht der Anzahl der fur jede Vorhalieposilion auf- 
genonmienen Messdalen, Die Dimension aller Messvekto- 
ren ist gleich groB. 

Fur jeden Freiheilsgrad werden die Messvektoren und der 
SoU-Messveklor dann weiierverarbeilet. Aus denselben 
Messdalen der Messvektoren eines Freiheilsgrades wird der 
BeU^g des Gradienlen ermittelt und in einer Gradientenma- 
lrix gespeichert Die Gradicnlcnmatrix hal somil die Dimen- 
sionen (Anzahl der fttr jede Vorhalieposilion aufgenomme- 
nen Messdalen) x (Anzahl der Freiheiisgrade). £s ist denk- 
bar, den Kchrwert dcr Gradientenmalrix bereiis in dcm Pa- 
rameter-Mode zu bercchnen und abzuspeichcm. Vorzugs- 
weise wird er aber erst in dem nachfolgenden Operation- 
Mode berechnel. Damit ist die TVainingsphase fur diese 
Sol I- Vorhalieposilion abgeschlossen. Die Gradientenmalrix 
kann auch als Jakobimalrix oder als Sensibililatsmatrix be- 
zeichnet werden. 

Tm Rahmen des Operation-Mode wird dann fur die Rege- 
lung der Vorhalieposilion des Manipulators ein Ist-Mess- 
veklor ennilleli, d. h. es werden die Messdalen in der mo- 
menlanen Vorhalieposilion des Manipulators des Handha- 
bungsgerals ermitlell und in dem Isi-Messvektor gespei- 
chert. Dann wird ein Differenzveklor aus der Differenz des 
Soll-Messveklors und des Isl-Messveklors gebildel. Des 
Weiieren wird der Kehrwert der Gradientenmalrix berechnel 
und wahlweise abgespeichen. 

SchlieBlich wird ein Korreklurvektor aus der Multipiika- 
lion des Kehrwerts der Gradientenmalrix mil dem Diffe- 
renzveklor berechnel und die Vorhalieposilion in AbhSngig- 
keit von dem Korreklurvektor geregell. 

Dcr Korreklurvektor kann auch mittcls eines anderen ge- 
eigneten Verfahrens beslirnmi werden, bspw. durch den Ein- 



saiz eines sequcnliellcn Kahnanfillers. Derarligc geeignetc 
Verfahren zum Berechnen des Korrekturveklors sind aus 
dem Stand der Technik bekanni und k5nnen von einem 
Fachmann nach Belieben eingesetzi werden. Diese anderen 

5 geeigneten Verfahren haben den Vorlcil, dass auf cine rclaliv 
aufwendige Bildung des Kehrwerts der GradientenmaUix 
verzichlei werden kann. 

Wahrend des Operation- Mode fahrt der Manipulator zu- 
nachst die Vcrfahrbahn gcmaB den wahrend des Rccord- 

10 Mode gespeicherten Punklen ab. Diese Verfahrbahn wird 
dann im Rahmen der Regelung der Vorhalieposilion des Ma- 
nipulators mil Hilfe des Korrekturveklors korrigiert. Bei 
dem crfindungsgcmaBen Verfahren wird die Vorhaliepos- 
ilion also nichl absolui, sondem lediglich relativ zu einer 

IS Vorhalieposilion auf der gespeicherten Verfahrbahn gere- 
gell. 

Vorteilhaflerweise wird die Ist- Vorhalieposilion im Rah- 
men der Regelung der Vorhalieposilion um einen Bruchleil 
des Korrekturveklors korrigiert und anschlieBend der Ist- 

20 Messveklor in der korrigierlen Ist- Vorhalieposilion und dar- 
aus der Korreklurvektor emeul ennilleli. Die Ist- Vorhali- 
eposilion wird also nicht um den gesamten Korreklurvektor 
korrigiert Um ein {jberschwingen der Regelung zu verhin- 
dem, wird vielmehr versucht, sich der Soli- Vorhalieposilion 

25 langsam von einer Richtung her anzunahem. Dadurch wird 
eine Regelung mil einem gedampften Einschwingverhalten 
realisiert Durch eine geeignete Wahl des Bruchteils des 
Korrekturveklors kann die Dampfungskonslante der Rege- 
lung beslirnmi werden. 

30 Die Regelung der Vorhalieposilion wird vorzugsweise ab- 
gebrochen, wenn jedes der Elemente des Korrekturveklors 
kleiner als ein Abbruchkriierium ist Durch eine geeignete 
Wahl des Abbruchkriteriums kann einerseits die Genauig- 
keil der Regelung und andererseils die Regelungsgeschwin- 

35 digkeil bestimmi werden. Je kleiner der Wert des Abbruch- 
kriteriums gcwahll wird, desto genauer kann die Regelung 
der Vorhalieposilion durchgefuhrl werden. Ein kleiner Wert 
des Abbruchkriteriums bedeutet jedoch auch, dass die Rege- 
lung mehr Zeil benotigt, bis das Abbruchkriierium erfUlll 

40 ist 

Um eine Regelbarkeii der Vorhalieposilion des Manipula- 
tors innerhalb eines bestimralen Arbeitsvolumens der Rege- 
lung sicherzuslellen, soUten die aufgenommenen Messvek- 
toren nach Moglichkeii das gcsamlc Arbeilsvolumen abdek- 

45 ken. Des Weiteren solllen fUr jeden Freiheilsgrad so viele 
Messvektoren aufgenommen werden, dass eine zuverlassige 
Bcrechnung des BcU^gs des Gradienlen dcr Messdalen 
moglich ist Deshalb wird gcmaB einer bevorzugten Ausfuh- 
rungsform der Erfindung vorgeschlagen, dass fiir jeden Frei- 

50 heitsgrad von der SoU-Vorhalteposidon aus mindestens zwei 
Messvektoren in jede Richtung aufgenommen werden. Vor- 
teilhaflerweise werden jedoch fur jeden Freiheilsgrad von 
der Soll-Vorhalleposition aus funf Messvektoren in jede 
Richtung aufgenommen. Somil ergeben sich fiir jeden Frei- 

55 heitsgrad zehn Messvektoren und der Soll-Messveklor, also 
elf Messvektoren. Fiir jedes der aufgenommenen und in den 
Messvektoren gespeicherte Messdalum wird dann der Be- 
trag des Gradienlen berechnel und in der Gradientenmalrix 
abgespeichert. 

60 Die Messvektoren miissen zusammen fiir jeden Freiheils- 
grad, in dem die Vorhalieposilion des Manipulators des 
HandhabungsgerSts geregell wird, mindestens ein unabhSn- 
giges Messdalum enthalten. GemaB einer weiteren bevor- 
zugten Ausfuhrungsform der Erfindung wird vor;geschlagen, 

f& dass die Messvektoren zusammen mindestens sechs Mess- 
dalen enthalten. Dadurch kann die Position und Ausrichtung 
des Manipulators relativ zu dcm Objckl in sechs Frciheils- 
graden eindeulig charaklerisiert werden. Dainil kann die 
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Vorhalteposition dcs Manipulators um sechs Freihciisgrade 
im dreidimensionaien Raum geregell werden. Voraugsweise 
enthalten die Messvektoren jeweils 32 Messdaten. 

Eine weiiere Aufgabe der vorliegenden Erfindung besleht 
darin, einc Vorrichtung dcr cingangs genannien Art dahinge- 5 
hend auszugesiallen und weiterzubilden, dass eine mog- 
lichst schnelle Regelung der Vorhalteposition erreicht und 
dass insbesondere hohere Verfahr^eschwindigkeiten des 
Manipulators auf dcr Vcrfahrbahn rcalisicrt werden konnen, 
ohne dass es zu einem Verlust an Regelungsgenauigkeil lO 
kommt. 

Zur Ix)sung dieser Aufgabe schlagt die Erfindung ausge- 
hcnd von dcr Vorrichtung dcr cingangs gcnanntcn An vor, 
dass die V:>rrichtung Miltel zur Durchfuhrung des Verfah- 
rens nach einem der Anspriiche 1 bis 13 aufweist. IS 

Eine weitere Aufgabe der vorliegenden Erfindung besleht 
schlieBlich darin, ein Handhabungsgeral der eingangs ge- 
nannien Art dahingehend auszugeslalten und weilerzubil- 
den, dass eine mtiglichst schnelle Regelung der Vorhaltepos- 
ition erreicht und dass insbesondere hohere Verfahrge- 20 
schwindigkeilen des Manipulators auf der Verfahrbahn rea- 
lisiert werden konnen, ohne dass es zu einem Verlust an Re- 
gelungsgenauigkeil kommt. 

Zur Losung dieser Aufgabe schlagt die Erfindung ausge- 
hend von dem Handhabungsgeral der eingangs genannien 25 
Art vor, dass das Handhabungsgeral Mitlel zur Durchfuh- 
rung des Verfahrens nach einem der Anspriiche 1 bis 13 auf- 
weist. 

Die erfindungsgemaBe Vorrichtung und das erfindungsge- 
maBe Handhabungsgeral weisen insbesondere Mittel auf, 30 
um in einem Record-Mode mehrere Punkte zumindesl eines 
Tcils der 1st- Vcrfahrbahn zu spcichcm und die gcspcichertcn 
Punkte dann in einem Operation-Mode fiir eine voraus- 
schauende Regelung der Vorhalteposition des Manipulators 
enllang dieses Teils der Verfahrbahn heranzuziehen. Des 35 
Weitcren weisen die erfindungsgemaBe Vorrichtung und das 
erfindungsgemaBe Handhabungsgeral Miltel auf, um in ei- 
nem Parameter-Mode im Rah men einer Trainingsphase den 
Manipulator in eine Soli- Vorhalteposition zu fahren, um den 
Manipulator um die einzelncn Freiheitsgradc dcs Handha- 40 
bungsgerals in andere Vorhalteposiiionen zu verfahren und 
fiir jeden Freiheitsgrad in jeder Vorhalteposition die Mess- 
daten aufzunehmen und zu speichem, durch die die enlspre- 
chendc Vorhalteposition charaktcrisiert isl. 

Bei der erfindungsgemSBen Vorrichtung und dem erfin- 45 
dungsgemMBen Handhabungsgeral kann die Verfahrge- 
schwindigkcit dcs Manipulators aufgrund dcr vorausschau- 
cndcn Regelung bcsondcrs groB gcwahlt werden. AuBcrdcm 
erselzt die Trainingsphase das Einnchten und Kalibrieren 
der Sensoren. Mil der erfindungsgemaBen Vorrichtung und 50 
dem erfindungsgemaBen Handhabungsgeral ist somit cine 
schnellere Regelung der Vorhalteposition moglich, ohne 
dass es zu einem Veriust an Regelungsgenauigkeil kommt. 

GemaB einer vorteilhaflen Weiierbildung der voriiegen- 
den Erfindung wird vorgeschlagen, dass an dem Manipula- 55 
tor des Handhabungsgerats zur EnnilQung der Isl- Vorhalt- 
eposition des Manipulators relaiiv zu dem Objekl minde- 
stens ein Sensor befestigt ist. 

Der Oder jeder Sensor isl vorteilhafterweise derart relativ 
zu dem Objekl angeordnel, dass die Folge der Messdaten 60 
der fur einen Freiheitsgrad aufgenommenen Messvektoren 
streng monoton ist. Dies ist eine wichtige N^rausselzung, 
um den Manipulator aus alien Posiiionen und Ausrichlun- 
gen relativ zu dem Objekl stets in die gewUnschte Soll-Vfcr- 
halleposition regeln zu kdnnen. 65 

Des Weiteren muss die Beohachtharkeit der Regelung si- 
chei^eslelll scin. Dcshalb wird gcmaB einer andcrcn vorteil- 
haflen Ausfiihrungsfonn der Erfindung vorgeschlagen, dass 
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der Oder jcdcr Sensor derart relativ zu dem Objekl angeord- 
nel isl, dass in der Gradientenmauix fur jeden Freiheitsgrad 
jeweils fur mindestens einen aufgenommenen Messdaten 
ein Gradienten-Betragswert enthalten ist. 

Damil die in der Gradientenmauix im Rahmcn der Rege- 
lung der Vorhalteposition auch verarbeitet werden konnen, 
und zu einem zuverlassigen Ergebnis fuhren, wird vorge- 
schlagen, dass der oder jeder Sensor derart relativ zu dem 
Objekl angcordnct ist, dass die Gradicntcn-Bcuragswerte in 
der Gradientenmalrix signifikanl sind. Man sprichl von si- 
gnifikanten Gradienien-Betragswerten, wenn diese von dem 
Messrauschen der aufgenommenen Messdaten unterscheid- 
bar sind. Die Gradicntcn-Belragswertc sind bspw. untcr- 
scheidbar, wenn sie elwa doppelt so groB sind wie das Mess- 
rauschen der aufgenonunenen Messdaten. Falls die Gra- 
dientenstarke nichl ausreichend groB isl, wird der entspre- 
chende Gradienten-Betragswert als nichl vorhanden gewer- 
lel. Die Gradienlen-BeU-agswerte in der Gradientenmauix 
sind vorzugsweise in elwa mindestens dreimal so grofi wie 
das Messrauschen. 

Die Krilerien der Monotonie der Folge der Messdaten, 
der Beobachibarkeil der Regelung und der Gradienlenstarke 
konnen durch die Position der Sensoren relativ zu dem Ma- 
nipulator beeinflusst werden. Der genaue Bezug der Senso- 
ren zu dem Manipulator isl allerdings von unlergeordneler 
Bedeutung, solange die o. g. Krilerien erfullt sind. Der Be- 
zug der Sensoren zu dem Manipulator wird wahrend der 
Trainingsphase erfassi und uber die aufgenommenen und 
abgespeicherten Messdaten in der Regelung berucksichligt. 

GemaB einer bevorzugten Ausfuhrungsform der vorlie- 
genden Erfindung wird voi^eschlagen, dass der oder jeder 
Sensor als ein optischer Sensor, insbesondere als cine CCD- 
Kamera, ausgebildet ist. Millels CCD-Kameras kann ein 
Objekt auf vielfaltige Weise charaktcrisiert werden. Es ist 
denkbar, dass die Messdaten bei als CCD-Kameras ausge- 
bildclcn Sensoren als Abstande zwischen den Sensoren und 
dem Objekt, als Pixel auf dem CCT)-Chip o, a. ausgebildet 
sind. (XD-Kameras haben zudem den Vorteil, dass ihr 
Blickfeld zum Ausrichien der Sensoren relativ zu dem Ob- 
jekt auf einem Bildschirm dargcstcllt werden kann. Das cr- 
leichtert die Ausrichtung der Sensoren erheblich. 

Ein bevorzugtes Ausfiihrungsbeispiel der vorliegenden 
Erfindung wird im Folgenden anhand der Zeichnung naher 
crlaulcrt. Es zcigt: 

Fig. 1 ein erfindungsgem^Bes Handhabungsgeral gemSB 
einer bevorzugten Ausfuhrungsform; 

Fig. 2 den Manipulator des Handhabungsgerats aus Fig. 1 
im Ausschnill; und 

Fig. 3 eine Verfahrbahn eines erfindungsgemaBen Hand- 
habungsgerats. 

In Fig. 1 ist ein crfindungsgcmafies Handhabungsgeral in 
seiner Gesamlheit mil dem Bezugszeichen 1 gekennzeich- 
nel. Das Handhabungsgeral 1 weisi einen Manipulator 2 auf, 
der in sechs Freiheilsgraden (x, y, z, a, b, c) bewegbar ist. 
Das Handhabungsgeral 1 ist bspw. als ein Indusuie-Roboter 
ausgebildet, dessen Manipulator 2 bspw. als ein beliebiges 
Werkzeug oder als ein Messkopf zur Aufnahme beUebiger 
MessgroBen (Temperatur, Abstand, etc.) ausgebildet ist. 

Damil der Manipulator 2 die ihm zugedachte Aufgabe er- 
fiillen kann, muss er in eine definierte Vorhalteposition (vgl. 
Fig. 2) relativ zu einem Objekl 3 gebracht werden. Unter 
dem Begriff Vorhalleposition wird gemSB dem voriiegenden 
Patent auch die Ausrichtung des Manipulators 2 relativ zu 
dem Objekl 3 verslanden. Die Erfindung schlagt ein Verfah- 
ren zur Regelung der N^rhalteposiiion vor. Das erfindungs- 
gemaBe Verfahren kann nichl nur fUr jede Art von Pick-and- 
placc-Anwcndungen, sondern auch fiir Anwcndungcn, bei 
denen einem besiimmten Linienverlauf gefolgl werden 
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muss, bspw. zum SchweiBcn, Klcbcn odcr Abdichtcn von 
Kanten. eingeselzl werden. 

GemaB dem vorliegenden Ausfuhrungsbeispiel soU ein 
Schiebedach 4 eines KraftfahTOugs von dem Manipulator 2 
crgriffcn und in cine entsprcchcndc Offnung (Objcki 3) im 
Dach 5 der Karosserie des Kraflfahrteugs eingeselzl wer- 
den. Der Manipulaior 2 isi als ein Saugnapf zum Greifen des 
Schiebedachs 4 ausgebildei. Die Vorhalteposition ist eine 
Position obcrhalb der Offnung. von der aus das Schiebedach 
4 in einer geradlinigen, senkrechien Bewegung nach unlen 
in die Offnung bewegl werden kann. 

Das Handhabungsgerai 1 weist eine interne Steuerungs- 
cinrichtung 6 auf. Auf der Stcuerungseinrichtung 6 ist ein 
Steuerungsprogramm lauffahig, durch das der Manipulator 
2 entlang einer programmierten Verfahrbahn (vgl. Fig. 3) in 
die Vorhalteposition bewegt werden kann. Wenn das Objekt 
3, im vorliegenden Ausfuhrungsbeispiel die Offnung im 
Dach 5 der Karosserie des Kraftfahrzeugs, slets an derselben 
Position angeordnel ist, reicht eine solche Steuerung der 
Verfahrbahn bis zur Vorhalteposition vollkommen aus. Falls 
die Position des Objekls 3 jedoch gewissen Schwankungen 
unlerworfen isl, kann durch eine Sleuerung alleine nichl 
mehr sichergeslellt werden, dass eine bestimmte Vorhalt- 
eposition des Manipulators 2 relaliv zu dem Objekl 3 slets 
mil der erforderlichen Genauigkeii eingenommen wird. 
Schwankungen des Objekls 3 konnen sich bspw. aufgrund 
von Ungenauigkeilen bei der Positionierung der Karosserie 
relativ zu dem Handhabungsgerai 1 oder aufgrund der Be- 
wegung der Karosserie des Kraftfahrzeugs auf einer Ferti- 
gungsstraBe ergeben. 

Um sichcfTiustellen, dass die Vorhalteposition des Mani- 
pulators 2 relativ zu dem Objekt 3 auch bei Schwankungen 
der Position des Objekls 3 slets mil der geforderten Genau- 
igkeii eingenommen wird, wird in solchen Fdllen die \fer- 
halteposition des Manipulators 2 relativ zu dem Objekt 3 ge- 
regclt. Aus dem Stand der Tcchnik sind mehrere Verfahrcn 
zur Regelung der Vorhalleposilion des Manipulators 2 be- 
kannt. Diese Verfahren sind jedoch sehr arbeits- und zeilauf- 
wendig. 

Das erfindungsgcmaBe Verfahren zur Regelung der Vor- 
halteposition des Manipulators 2 weist verschiedene Merk- 
male zur Beschleunigung und Vereinfachung der Regelung 
auf. Das Verfahren ist auf einer extemen Regelungseinrich- 
lung 7 implementierl (vgl. Fig. 1). Die Regelungscinrich- 
tung 7 isl als ein herkommlicher Personal-Computer (PC) 
Oder Indusuie-P(J ausgebildei. Auf der Regelungseinrich- 
tung 7 ist ein Regclungsprogranun, das in einer herktimmli- 
chcn Programmicrsprachc programmiert ist, lauffahig. In 
Fig. 1 ist die Regelungseinrichtung 7 als von dem Handha- 
bungsgerai 1 getrennt ausgebildei. Hs ist jedoch auch denk- 
bar, dass die Regelungseinrichtung 7 in das Handhabungs- 
gerai 1 inlegrierl ist. Das Steuerungsprogramm der Stcue- 
rungseinrichtung 6 isl in einer proprielaren, nur auf der 
Stcuerungseinrichtung 6 dieses Handhabungsgerats 1 lauf- 
fahigen Programmiersprache programmiert. Das Steue- 
rungsprogramm weist an bestimmien Slellen Prograimnier- 
befehle (Aufrufbefehle, Ruckholbefehle) auf, um das Rege- 
lungsprogramm der extemen Regelungsvorrichtung 7 von 
dem Steuerungsprogramm aus aufzurufen bzw. um von dem 
Regelungsprogramm wieder zu dem Steuerungsprogramm 
zurUckzukehren. Zwischen der Steueningseinrichtung 6 und 
der Regelungseinrichtung 7 ist eine Datenleitung 8 zum 
Austausch von Daten voi^gesehen. 

In Fig. 2 ist zu erkennen, dass an dem Manipulator 2 vier 
als (XID-Kameras ausgebildete Sensoren 9 angeordnel sind. 
Durch die Sensoren 9 werden die VerlSufe der Kanten 10 in 
Relation zu dem Manipulator 2 gcsetzi. Dazu werden Mess- 
daten. die ini vorliegenden Ausfuhrungsbeispiel als Pixel- 
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wertc der CCD-Chips der Sensoren 9 ausgebildei sind, auf- 
genommen und in Messvekloren gespeicherl. 

Das erfindungsgemSBe Verfahren zur Regelung der Vor- 
halteposition des Manipulators 2 relativ zu dem Objekt 3 

5 weist drci unterschiedlichc Bctricbszustandc auf. In cincm 
ersien Betriebszustand, dem sog. Record-Mode, wird die 
Verfahrbahn A bis B (vgl. Fig, 3) zu einer Vorhalteposition 
bin und von der Vorhalteposition weg von dem Steuerungs- 
programm der Sieucrungscinrichtung 6 gcstcuerl abgefah- 

10 ren. In dem Bereich der Verfahrbahn zwischen den Punkien 
C und D liegi ein fUr die Regelung interessanter Bereich mil 
einem oder mehreren Vorhaltepositionen des Manipulators 
2, die relativ zu dem Objekt 3 gcregelt werden soUen. Wenn 
der Manipulator 2 beim Abfahren der Verfahrbahn den 

15 Punkt C erreicht hat, wird das Regclungsprogranun der Re- 
gelungseinrichtung 7 aufgerufen. Wahrend des gesteuerten 
Abfahrens der Verfahrbahn von dem Punkt C bis D werden 
dann einer oder mehrere Punkle von dem Regelungspro- 
gramm aufgenommen und gespeicherl. Wenn die Verfahr- 

20 bahn den Punkt D erreicht hat, wird das Regelungspro- 
gramm beendel, Damil isl der Record-Mode beendel. Auf 
die gespeicherlen Punkle der Verfahrbahn wird dann in ei- 
nem dritten Betriebszustand der Regelung zugegriffen. 
In einem zweilen Betriebszustand, dem sog. Parameler- 

25 Mode, fahrl der Manipulator 2 von dem Steuerungspro- 
gramm gesleuert die Verfahrbahn von dem Punkt A zu dem 
Punkt C ab. Wenn die Verfahrbahn den Punkt C erreicht hat, 
wird das Regelungsprogramm aufgerufen, und die Steue- 
rung des Manipulators 2 wird von dem Steuerungspro- 

30 gramm an das Regelungsprogramm abgegeben. Das Rege- 
lungsprogramm Wfin die gespeicherte Verfahrbahn zwi- 
schen den Punkten C und D ab. Auf der Verfahrbahn werden 
diejenigen Vorhaltepositionen angefahren, die relativ zu 
dem Objekl geregelt werden sollen, und fur jede Vorhalt- 

35 eposition wird eine Trainingsphase durchlaufen. Wenn die 
von dem Regelungsprogramm gcsteucrlc Verfahrbahn den 
Punkt D erreicht hat, wird das Regelungsprogramm beendel 
und die Steuerung des Manipulators 2 entlang der Verfahr- 
bahn wieder an das Steuerungsprogramm zuriickgegeben. 

40 Der Manipulator 2 fahrl dann von dem Steuerungspro- 
gramm gesleuert die restliche Verfahrbahn von dem Punkt D 
bis B ab. Damil ist der Parameter-Mode beendel. 

Fiir jede Vorhalteposition, die relativ zu dem Objekl 3 ge- 
regelt werden soli, wird eine Trainingsphase durchgefuhrt. 

45 Dazu wird zunachst die Soil- Vorhalteposition mil dem Ma- 
nipulator 2 angefahren, und von den Sensoren 9 werden die 
Wertc von 32 Messdatcn, durch die die Soli- Vorhaltepos- 
ition charakterisiert ist, aufgenommen und in einem Soll- 
Messvektor y_soll gespeicherl. Der Soll-Messvektor y_soll 

SO hat somit die Dimension 32 x I (32 Messdaten x 1 Wert). 
AnschlieBend wird der Manipulator 2 nachcinander um je- 
den der sechs Freiheitsgrade in fUnf Vorhaltepositionen in 
der einen Richtung der Soil- Vorhalteposition und in fUnf 
Vorhaltepositionen in der anderen Richtung der Soll-Vor- 

55 halteposition bewegt. In jeder Vorhalteposition werden die 
enlsprechenden Werte der 32 Messdaten aufgenommen und 
in Messvekloren gespeicherl. Aus den zehn Messvekloren 
und dem Soll-Messvektor y_soll wird dann fiir jeden der 
sechs Freiheitsgrade der BeU-ag des Gradienten eines be- 

60 slimmten Messdalums berechnel und in einer Gradienten- 
matrix C abgespeichert. Die Gradienienmaurix C hat somil 
die Dimension 32 x 6 (32 Messdaten x 6 Freiheitsgrade). 
Fur jeden der zu regelnden Vorhaltepositionen erhfill man 
somit einen Soll-Messvektor y_soU und die Gradienlenma- 

65 trixC. 

In einem dritten Betriebszustand, dem sog. Operation- 
Mode, fahn der Manipulator 2 von dem Steuerungspro- 
gramm gesleuert die Verfahrbahn von dem Punkt A zu dem 
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Punk! C ab. Wcnn die Vcrfahrbahn den Punki C crrcichl hai, 
wird das Regelungsprogramrn aufgerufen. und die Sleue- 
rung des Manipulators 2 wind von dem vSteuerungspro- 
gramm an das Regelungsprogramrn abgegeben. Das Rege- 
lungsprogramrn fahrt die gespcicherte Vcrfahrbahn zwi- 5 
schen den Punklen C und D ab. Die gespeicherlen Punkle 
der Vcrfahrbahn erlauben cine vorausschauende Regelung 
der Vorhallepunkie auf der Vcrfahrbahn, was bei gleicher 
Oder sogar hohercr Genauigkeit eine wesendich hohere Vcr- 
fahrbahngeschwindigkeil als bei den aus dem Stand der to 
Technik bekannten Verfahren zum Regeln der \forhaliepos- 
ition eines Manipulators ermdglicht. 

In dem Bcrcich der Vcrfahrbahn zwischen den Punktcn E 
und F liegt ein fur die Regelung inleressanler Bereich mil ei- 
nem oder mehreren Vorhaltepositionen des Manipulators 2, 15 
die relativ zu dem Objekt 3 geregelt werden sollcn, Sobald 
die Vcrfahrbahn den Punkl E erreicht hat» erfolgl cine Rege- 
lung der Vorh alte pes i lion auf der Vcrfahrbahn. Im Rahmen 
der Regelung der Vorhalteposition werden von den Scnso- 
ren 9 zunachst in der momentanen 1st- Vorhalteposition die 20 
entsprechenden Werle der Messdalen aufgenornmen und in 
einem Ist-Messvcklor y Jst gespeicherl. Der Isl-Messveklor 
y_isi hat ebenfalls die Dimension 32 x 1 (32 Messdalen x 1 
Wert). Aus der Diffcrenz des SoU-Messveklors und des Ist- 
Messveklors wird ein DifTerenz-Messvektor D_y gebildel 25 
(D_y = y soil - y_ist). Der DifTerenz-Messvektor D_y hat 
ebenfalls die Dimension 32 x 1 . Dann wird der Kehrwen. 
der Gradientenmatrix C berechnet und wahlweise abgespei- 
chert. Aus dem Produkl des Kehrwerts des Gradientenvek- 
tors C und des Ditferenz-Messvektors D_y wird ein Korrek- 30 
turvektor D_x ermiltelt, der ebenfalls die Dimension 32 x 1 
hat. £s ist jcdoch auch denkbar, dass der Korrckturvektor 
D_x miltels eines anderen geeignelen Verfahrens, bspw, 
durch den Einsatz eines sequentiellen Kalraanfillcrs, ermit- 
telt wird. 35 

Ein Toil des Korrckturvcktors D_x, vorzugswcisc etwa 
10% des Korrekturvekiors D_x, wird zur Korreklur der Isl- 
Vorhalleposition des Manipulators 2 herangezogen. In der 
neuen Ist-Vorhalteposiiion werden emeut die entsprechen- 
den Wertc der Messdalen aufgenornmen und in cinem Ist- 40 
Messvektor y_isi gespeichert. Wie oben bcreits beschrieben 
wird emeut ein Korrckturvektor D_x berechnet und die Ist- 
Vorhaltcposition in Abhangigkeit von dem Korrckturvektor 
D_x korrigicn. Die Korrcktur der Ist- Vorhalteposition wird 
so lange wiederholu bis die einzelnen Werte des Korrcktur- 45 
vektors D_x ein bestinimies Abbruchkriterium erfullt ha- 
bcn, d. h. bis der Manipulator 2 auf die Soil- Vorhaltepos- 
ition geregelt ist. 

Paientanspriiche so 

1 . Verfahren zur Regelung der Vorhalteposition eines 
in mchreren Freiheitsgraden bewegbaren Manipulators 
(2) eines Handhabungsgerals (1) relativ zu einem Ob- 
jekt (3) enllang eincr Vcrfahrbahn, dadurch gckcnn- 55 
zelchnet, dass rnehrere Punkle zumindesl eines 'Jbils 
der Ist- Vcrfahrbahn gespeicherl sind und fur cine vor- 
ausschauende Regelung der Vorhalteposition des Ma- 
nipulators (2) enllang dieses Teils der Vcrfahrbahn her- 
angezogen werden. 60 

2. Verfahren nach Anspruch 1, dadurch gekennzeich- 
net, dass die Ist- Vcrfahrbahn des Manipulators (2) vor 
der Regelung der Vorhalteposition abgefahren wird 
und dabei die Punkle zutnindest eines Teils der Ist- Vcr- 
fahrbahn aufgenommen und abgespeichert werden. 65 

3. Verfahren nach Anspruch 2, dadurch gekennzeich- 
nct, dass die Ist-Verfahrbahn von dem Manipulator (2) 
vor der Regelung der Vorhalteposition von einer inter- 
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ncn Stcucrungscinrichtung (6) des Handhabungsgerals 

(1) gesieuert abgefahren wird. 

4. Verfahren nach Anspruch 2 oder 3, dadurch gckenn- 
zeichnct, dass die Punkte zumindesl eines Tleils der Isl- 
Vcrfahrbahn von einer exlcmcn Rcgclungseinrichtung 
(7) aufgenommen und abgespeichert werden. 

5. Verfahren nach Anspruch 3 und 4, dadurch gekenn- 
zeichnet, dass die exteme Rcgclungseinrichtung (7) 
von der intcmcn Stcuerungseinrichtung (6) aufgerufen 
wird. 

6. Verfahren zur Regelung der Vorhalteposition eines 
in mehreren Freiheitsgraden bewegbaren Manipulators 

(2) cincs Handhabungsgerals (1) relativ zu einem Ob- 
jekt (3) enllang einer Vcrfahrbahn, insbesondere nach 
einem der Anspriiche 1 bis 5, dadurch gekennzeichnet, 
dass die Soil- Vorhalteposition des Manipulators (2) vor 
der Regelung der Vorhalteposition angefahren wird. 
wahrend einer Veninderung der Soll-Vorhalleposilion 
um jewel Is einen FreiheiLsgrad Messdalen, durch die 
die Vorhalteposition des Manipulators (2) charaktcri- 
sierl ist, aufgenommen und gespeicherl werden und die 
Regelung der Vorhalteposition in Abhangigkeil von 
den Messdalen durchgefuhn wird. 

7. Verfahren nach Anspruch 6, dadurch gekennzeich- 
net, dass vor der Regelung der Vorhalteposition 

- die Soli- Vorhalteposition angefahren wird, 

- ein Soll-Messvektor (y_soll) mil den Messda- 
len aufgenommen wird, 

- rUr jeden Freiheitsgrad der Manipulator (2) des 
Handhabungsgerals (1) aus der Soll-Vorhallepos- 
idon heraus in rnehrere Vorhaltepositionen be- 
wcgi und in jeder Vorhalteposition cin Messvektor 
aufgenommen wird, 

- fur jeden Freiheitsgrad fiir dieselben Messdalen 
der Messvektoren der Betrag des Gradienten cr- 
mittclt und in eincr Gradientenmatrix (C) gespei- 
cherl wird, und im Rahmen der Regelung der Vor- 
halteposition 

- ein Korrckturvektor (D_x) aus der Multiplika- 
uon des Kehrwerts der GradienlcnmaUix (C) mil 
der Differcnz des Soil-Mess vektors (y^soll) und 
eines Isl-Messvektors (yjst) in der Ist-Vorhalt- 
eposidon des Manipulators (2) oder anhand eines 
anderen geeignelen Verfahrens crmillclt wird und 

- die Vorhalteposition in Abhangigkeit von dem 
Korrekturvektor (D_x) geregelt wird, 

8. Verfahren nach Anspruch 7, dadurch gekennzeich- 
net, dass die Ist- Vorhalteposition des Manipulators (2) 
im Rahmen der Regelung der Vorhalteposition um ei- 
nen Bruchteil des Korrckturvcktors (D_x) konrigierl 
wird und anschlicBcnd der Ist-Mcssvektor (y_ist) in der 
korrigierten Ist- Vorhalteposition und daraus der Kor- 
rckturvektor (D_x) emeut ermiitelt wird. 

9. Verfahren nach Anspruch 8, dadurch gekennzeich- 
net, dass die Regelung der Vorhalteposition abgebro- 
chen wird, wcnn jedes der Elemenle des Korrekturvek- 
lors (D_x) kleiner als ein Abbruchkriterium ist. 

10. Verfahren nach Anspruch 8 oder 9, dadurch ge- 
kennzeichnet, dass fiir jeden Freiheitsgrad von der 
Soil- Vorhalteposition aus mindeslens zwei Messvekto- 
ren in Jede Richtung aufgenommen werden. 

11. Verfahren nach Anspruch 10. dadurch gekenn- 
zeichnet, dass fur jeden Freiheitsgrad von der SoU-Vor- 
halleposidon aus funf Messvektoren in jede Richtung 
aufgenommen werden. 

12. Verfahren nach einem der Ansprtiche 1 bis 5, da- 
durch gekennzeichnet, dass die Messvektoren zusam- 
men mindeslens sechs Messdalen enlhallen, damit die 
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Position und Ausrichtung des Manipulators (2) rciativ 
zu dem Objeki (3) im dreidimensionalen Raum chardk- 
lerisiert isl. 

13. Verfahren nach Anspmch 12, dadurch gekenn- 
zeichnet, dass die Mcssvcklorcn jcwcils 32 Mcssdatcn 5 
enihallen. 

14. Vorrichtung zur Regelung der Vorhalteposition ei- 
nes in mehreren Freiheitsgraden bewegbaren Manipu- 
lators (2) cincs Handhabungsgerals (1) relativ zu cinem 
Objeki (3) enllang einer Verfahrbahn, dadurch gekenn- 10 
zeichnet, dass die Vorrichtung Mittel zur Durchfuhrung 
des Verfahrens nach einem der Anspriiche 1 bis 1 3 auf- 
weist. 

15. Handhabungsgeral (1) mil einem in mehreren Frei- 
heitsgraden bewegbaren Manipulator (2), dessen Vor- IS 
halteposition relativ zu einem Objekt (3) regelbar ist, 
dadurch gekennzeichnet, dass das Handhabungsgeral 
(9) Millel zur Durchfuhrung des Verfahrens nach ei- 
nem der Anspriiche 1 bis 13 aufweisi. 

16. Handhabungsgeral (1) nach Anspruch 15, dadurch 20 
gekennzeichneu dass an dem Manipulator (2) des 
Handhabungsgerals (1) zur Ermiltlung der 1st- Vorhalt- 
eposition des Manipulators (2) relativ zu dem Objeki 
(3) mindestens ein Sensor (9) befestigt isl. 

17. Handhabungsgeral (1) nach Anspruch 16, dadurch 25 
gekennzeichnet, dass der oder jeder Sensor (9) derart 
relativ zu dem Objeki (3) angeordnetisl, dass die Folge 
der Messdaien der fur einen Freiheiisgrad aufgenom- 
menen Messvekloren su-eng monoton isl. 

18. Handhabungsgeral (1) nach Anspruch 17, dadurch 30 
gekennzeichnet, dass in der Gradientenmatrix (C) fur 
jcden Freiheiisgrad jcweils fUr mindestens ein aufgc- 
nommenes Messdatum ein Gradienlen-Beirdgswerl 
enihallen isl. 

19. Handhabungsgeral (1) nach Anspruch 18, dadurch 35 
gekennzeichnet, dass die Gradicnten-BcU-agswcrtc in 
der Gradienteninauix (C) signifikanl sind. 

20. Handhabungsgeral (1) nach einem der Anspriiche 
15 bis 19, dadurch gekennzeichnet, dass der oder jeder 
Sensor (9) als cin optischer Sensor ausgcbildet ist. 40 

21. Handhabungsgeral (1) nach Anspruch 20, dadurch 
gekennzeichnet, dass der oder jeder Sensor (9) als eine 
CCD-Kamera ausgebildet isl. 



Hierzu 2 Seite(n) Zeichnungen 45 



ZEICHNUNGEN SEITE 1 



Nummer 

Int. CI.': 

Offenlegungstag: 



DE19930087A1 

B25J 9/18 

11. Januar 2001 




002 062/363 



ZEICHNUNGENSErrE2 



Nummer 

Int. Cl.^: 

Offenlegungstag: 



DE19930087A1 
B25J 9/18 

11. Januar 2001 




002 062/363 



